#pragma config(Hubs,  S1, HTMotor,  HTServo,  none,     none)
#pragma config(Hubs,  S2, HTMotor,  HTMotor,  none,     none)
#pragma config(Sensor, S1,     ,                    sensorI2CMuxController)
#pragma config(Sensor, S2,     ,                    sensorI2CMuxController)
#pragma config(Sensor, S4,     angle,               sensorI2CCustomFastSkipStates9V)
#pragma config(Motor,  motorA,          C1,            tmotorNormal, PIDControl, encoder)
#pragma config(Motor,  motorB,          C2,            tmotorNormal, PIDControl, reversed, encoder)
#pragma config(Motor,  motorC,          C3,            tmotorNormal, PIDControl, encoder)
#pragma config(Motor,  mtr_S1_C1_1,     FL,            tmotorNormal, openLoop, reversed)
#pragma config(Motor,  mtr_S1_C1_2,     FR,            tmotorNormal, openLoop)
#pragma config(Motor,  mtr_S2_C1_1,     RL,            tmotorNormal, openLoop, reversed)
#pragma config(Motor,  mtr_S2_C1_2,     RR,            tmotorNormal, openLoop)
#pragma config(Motor,  mtr_S2_C2_1,     Arm,           tmotorNormal, openLoop, reversed)
#pragma config(Motor,  mtr_S2_C2_2,     Lift,          tmotorNormal, openLoop)
#pragma config(Servo,  srvo_S1_C2_1,    SpinL,                tServoStandard)
#pragma config(Servo,  srvo_S1_C2_2,    SpinR,                tServoStandard)
#pragma config(Servo,  srvo_S1_C2_3,    GrabL,                tServoStandard)
#pragma config(Servo,  srvo_S1_C2_4,    GrabR,                tServoStandard)
#pragma config(Servo,  srvo_S1_C2_5,    servo5,               tServoNone)
#pragma config(Servo,  srvo_S1_C2_6,    servo6,               tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

#include "include.h"

task main()
{
  MoveArm(inital);
  StartTask(PositionArm);
  while(!positioned){}
  MoveArm(lower);
  while(1==1){}
}
